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Abstract 


Scientists  at  Defence  R&D  Canada  -  Suffield  have  been  investigating  autonomous  operation  of 
Unmanned  Ground  Vehicles  (UGVs).  In  order  to  navigate  unknown  terrain  effectively,  UGVs 
must  be  able  to  create  an  accurate  representation  of  the  operational  environment.  This  is  typically 
done  by  constructing  a  geometric  representation  of  the  environment,  called  a  Terrain  Map,  from 
exteroceptive  and  proprioceptive  data  streams.  This  Terrain  Map  can  further  be  analyzed  to 
provide  a  measure  of  the  traversability  of  the  terrain.  The  resulting  Traversability  Map  can  be 
utilized  by  path  planning  and  obstacle  avoidance  algorithms  to  determine  the  “best”  path  to 
follow. 

This  paper  discusses  DRDC’s  Traversability  Map  as  a  method  of  world  representation.  The 
Traversability  Map  interprets  geometric  data  by  calculating  statistics  about  the  environment  to 
determine  whether  an  area  is  traversable  or  not.  In  doing  so,  the  Traversability  Map  interprets 
geometry  from  a  vehicle  specific  context,  allowing  for  the  unique  mobility  characteristics  of 
platforms  to  dictate  map  parameters. 


Resume 


Les  scientifiques  de  R  &  D  pour  la  defense  Canada  -  Suffield  ont  etudie  T  operation  autonome  de 
vehicules  terrestres  sans  pilote.  Ces  vehicules  doivent  etre  capables  de  creer  une  representation 
exacte  du  milieu  operationnel  pour  etre  en  mesure  de  naviguer  des  terrains  inconnus 
efficacement.  Ceci  est  generalement  obtenu  en  construisant  une  representation  geometrique  du 
milieu,  appelee  carte  moiphographique,  a  partir  de  flux  de  donnees  exteroceptives  et 
proprioceptives.  Cette  carte  moiphographique  peut  etre  analysee  plus  profondement  pour  mesurer 
la  possibilite  de  traverser  le  terrain.  La  carte  de  parcours  traversable  qui  en  resulte  peut  etre 
utilisee  par  des  algorithmes  de  planification  de  parcours  et  d’evitement  d’obstacles  pour 
determiner  le  «  meilleur  »  chemin  a  suivre. 

Cet  article  discute  de  la  carte  de  parcours  traversable  de  RDDC  comme  d’une  methode  de 
representation  du  monde.  Cette  carte  interprete  les  donnees  geometriques  en  calculant  les 
statistiques  concernant  l’environnement  pour  determiner  si  une  zone  est  traversable  ou  non.  De 
cette  maniere,  cette  carte  interprete  la  geometric  a  partir  du  contexte  specifique  d’un  vehicule 
ayant  les  caracteristiques  de  mobilite  toutes  particulieres  des  plateformes  capables  de  dieter  des 
parametres  cartographies. 
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Executive  summary 


Traversability  Analysis  for  Unmanned  Ground  Vehicles 

J.  Collier;  G.  Broten;  J.  Giesbrecht;  DRDC  Suffield  TM  2006-175;  Defence  R&D  Canada  - 
Suffield;  December  2006. 

Background:  Scientists  at  Defence  R&D  Canada  -  Suffield  have  been  investigating  autonomous 
operation  of  Unmanned  Ground  Vehicles  (UGVs).  In  order  to  navigate  unknown  terrain 
effectively,  UGVs  must  be  able  to  create  an  accurate  representation  of  the  operational 
environment.  This  is  typically  done  by  constructing  a  geometric  representation  of  the 
environment,  called  a  Terrain  Map,  from  external  and  internal  sensor  data.  This  Terrain  Map  can 
further  be  analyzed  to  provide  a  measure  of  the  traversability  of  the  terrain.  The  resulting 
Traversability  Map  can  be  utilized  by  path  planning  and  obstacle  avoidance  algorithms  to 
determine  the  “best”  path  to  follow. 

This  paper  discusses  the  DRDC’s  Traversability  Map  as  a  method  of  world  representation.  The 
Traversability  Map  interprets  geometric  data  by  calculating  statistics  about  the  environment  to 
determine  whether  an  area  is  traversable  or  not.  In  doing  so,  the  Traversability  Map  interprets 
geometry  from  a  vehicle  specific  context,  i.e.  a  particular  area  may  be  traversable  for  a  large 
UGV  but  impassable  for  a  smaller  UGV. 

Principal  Results:  Trials  were  conducted  in  the  fall  of  2006  to  assess  the  performance  of 
Traversability  Mapping  for  point  to  point  navigation  with  obstacle  avoidance.  A  Koyker  Raptor 
all  terrain  vehicle  which  had  been  modified  for  autonomous  navigation  was  used  as  a  test 
platform  for  the  trials.  The  results  are  summarized  as  follows: 

•  The  UGV  was  able  to  traverse  1.3km  of  gravel  road  terrain  with  minimal  intervention. 

•  The  Traversability  Map  correctly  identified  positive  obstacles  such  as  buildings,  signs, 
etc. 

•  Negative  obstacles  such  as  excessively  sloped  ditches  where  correctly  labelled  as 
impassable. 

•  False  obstacles  often  occurred  due  to  errors  in  terrain  data.  In  most  cases,  the  system  was 
able  to  recover  and  account  for  these  errors. 

•  Vegetation  would  often  appear  as  obstacles  in  the  map  regardless  of  whether  it  was 
traversable  or  not. 

•  The  UGV  followed  a  road  between  waypoints  without  prior  definition  of  a  road  or  its 
characteristics. 
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Significance  of  Results:  Based  on  the  results  assessed  above,  it  can  be  concluded  that  slope  and 
step  hazards  are  sufficient  metrics  to  determine  the  traversability  of  simple  terrain  such  as  asphalt 
or  gravel  roads.  Furthermore,  the  ability  of  the  UGV  to  effectively  road  follow  suggests  that  the 
Traversability  Map  could  be  used  as  input  to  a  road  following/recognition  system.  The  inability  of 
the  map  to  accurately  represent  vegetation  data  indicates  that  the  method  may  not  work  well  for 
off-road  terrain  traversal  though  supplementing  the  Traversability  Map  with  a  terrain 
classification  system  may  prove  effective. 

Future  Work:  Traversability  Mapping  work  will  focus  on  improving  system  robustness  and 
increasing  the  accuracy  of  the  maps.  Currently,  the  UGV  is  limited  to  running  at  very  slow  speeds 
as  a  result  of  a  mechanical  error  in  the  laser  nodding  mechanism  which  causes  large  errors  in  laser 
readings.  Improvements  to  this  mechanism  should  improve  map  generation  speeds.  In  addition, 
sun-visors  are  being  fabricated  to  reduce  the  instances  of  laser  dazzle.  Work  will  also  continue 
with  Traversability  Mapping  to  determine  the  robustness  of  the  algorithm.  Currently,  the  obstacle 
avoidance  algorithm  only  implements  discrete  traversability  (traversable,  impassable).  The 
capability  is  already  in  place  to  use  continuous  traversability  values  between  0  and  1.  This  could 
potentially  improve  the  effectiveness  of  the  Traversability  Map  for  obstacle  avoidance  as  rough 
areas  or  areas  near  obstacles  may  be  avoided.  Other  hazards  such  as  roughness  and  border 
hazards  should  be  evaluated  to  determine  their  effectiveness.  Furthermore,  the  Global 
Traversability  Map  has  yet  to  be  tested  with  DRDC’s  D*  Lite  implementation. 

Despite  the  successes  that  Traversability  Mapping  has  achieved  thus  far,  the  approach  does  not 
work  nearly  as  well  in  heavily  vegetated  areas  such  as  those  encountered  in  off-road  navigation. 
In  these  cases  the  map  is  unable  to  differentiate  between  “real”  obstacles  such  as  rocks  and 
“false”  obstacles  such  as  grass.  In  order  to  be  successful  in  this  environment  this  approach  must 
be  supplemented  with  a  learning  algorithm  which  would  allow  the  map  to  distinguish  between 
various  types  of  terrain.  AISS  has  been  conducting  research  in  Learned  Trafficability  for  a 
number  of  years  and  as  such  is  well  positioned  to  make  a  worthy  contribution  in  this  area. 
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Traversability  Analysis  for  Unmanned  Ground  Vehicles 

J.  Collier;  G.  Broten;  J.  Giesbrecht;  DRDC  Suffield  TM  2006-175;  R  &  D  pour  la  defense 

Canada  -  Suffield;  decembre  2006. 

Contexte  :  Les  scientifiques  de  R  &  D  pour  la  defense  Canada  -  Suffield  ont  etudie  l’operation 
autonome  de  vehicules  terrestres  sans  pilote.  Ces  vehicules  doivent  etre  capables  de  creer  une 
representation  exacte  du  milieu  operationnel  pour  etre  en  mesure  de  naviguer  des  terrains 
inconnus  efficacement.  Ceci  est  generalement  obtenu  en  construisant  une  representation 
geometrique  du  milieu,  appelee  carte  moiphographique,  a  partir  de  donnees  de  capteurs  extemes 
and  internes.  Cette  carte  moiphographique  peut  etre  analysee  plus  profondement  pour  mesurer  la 
possibilite  de  traverser  le  terrain.  La  carte  de  parcours  traversable  qui  en  resulte  peut  etre  utilisee 
par  des  algorithmes  de  planification  de  parcours  et  d’evitement  d’obstacles  pour  determiner  le  « 
meilleur  »  chemin  a  suivre. 

Cet  article  discute  de  la  carte  de  parcours  traversable  de  RDDC  comme  d’une  methode  de 
representation  du  monde.  Cette  carte  interprete  les  donnees  geometriques  en  calculant  les 
statistiques  de  l’environnement  pour  determiner  si  une  zone  est  traversable  ou  non.  De  cette 
maniere,  cette  carte  interprete  la  geometric  a  partir  du  contexte  specifique  d’un  vehicule,  comme 
par  exemple,  une  zone  particuliere  pouvant  etre  traversee  par  un  gros  vehicule  terrestre  sans  pilote 
mais  qui  serait  impassable  pour  un  vehicule  plus  petit. 

Resultats  principaux  :  On  a  conduit  des  essais  durant  rautomne  2006  qui  evaluaient  le 
rendement  de  la  cartographie  d’un  parcours  traversable  pour  naviguer  d’un  point  a  un  autre  en 
evitant  les  obstacles.  Le  Koyker  Raptor,  un  vehicule  tout  terrain  qui  avait  ete  modifie  pour  la 
navigation  autonome  avait  ete  utilise  comme  plateforme  de  test  pour  les  essais.  On  a  resume  les 
resultats  comme  il  suit : 

•  Le  vehicule  terrestre  a  ete  capable  de  traverser  1,3  km  de  route  gravillonnee  avec  un 
minimum  d’ intervention. 

•  La  carte  de  parcours  traversable  a  correctement  identifie  les  obstacles  positifs  tels  que  les 
batiments,  les  signaux,  etc. 

•  Les  obstacles  negatifs  tels  que  les  fosses  excessivement  profonds  ont  ete  releves  comme 
impassables. 

•  Des  faux  obstacles  ont  souvent  ete  releves  surtout  a  cause  d’erreurs  dans  les  donnees  de 
terrain.  Dans  la  plupart  des  cas,  le  systeme  a  ete  capable  de  se  corriger  et  de  tenir  compte 
de  ces  erreurs. 

•  La  vegetation  apparaissait  souvent  sur  la  carte  comme  un  obstacle  qu’elle  soit  traversable 
ou  non. 
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•  Le  vehicule  terrestre  a  suivi  une  route  entre  des  points  de  cheminement  sans  definition 
anterieure  de  la  route  ou  de  ses  caracteristiques. 

Portee  des  resultats  :  En  se  basant  sur  les  resultats  ci-dessus,  on  peut  conclure  que  les  dangers 
du  aux  pentes  ou  autres  sont  des  parametres  qui  suffisent  a  determiner  la  capacite  a  traverser  d’un 
terrain  simple  tel  que  les  routes  gravillonnees  ou  d’asphalte.  De  plus,  la  capacite  du  vehicule  a 
suivre  effectivement  la  route  suggere  que  la  carte  de  parcours  traversable  pourrait  etre  utilisee 
comme  donnee  d’ entree  dans  un  systeme  de  poursuite  et  de  reconnaissance  d’une  route. 
L’incapacite  de  la  carte  a  representer  les  donnees  de  vegetation  avec  exactitude  indique  que  cette 
methode  ne  fonctionnera  pas  tres  bien  pour  traverser  un  terrain  hors  route  bien  que  le  fait  de 
supplementer  la  carte  de  parcours  traversable  avec  un  systeme  de  classification  de  terrain  pourrait 
se  prouver  efficace. 

Travaux  futurs  :  Les  travaux  sur  les  cartes  de  parcours  seront  axes  sur  l’amelioration  de  la 
robustesse  du  systeme  et  de  E exactitude  des  cartes.  Le  vehicule  est  actuellement  limite  a  se 
deplacer  a  des  vitesses  tres  lentes  a  cause  d’une  erreur  mecanique  dans  le  mecanisme  de  laser 
basculant  causant  de  grosses  erreurs  dans  la  lecture  du  laser.  Les  ameliorations  apportees  a  ce 
mecanisme  devraient  ameliorer  la  vitesse  de  generation  de  cartes.  De  plus,  on  est  en  voie  de 
fabriquer  des  visieres  contre  le  soleil  pour  reduire  les  circonstances  d’aveuglement  du  laser.  Des 
travaux  continueront  aussi  sur  la  carte  de  parcours  traversable  pour  determiner  la  robustesse  de 
Lalgorithme.  L’algorithme  d’evitement  des  obstacles  n’implemente  actuellement  qu’une  valeur 
discrete  de  la  capacite  a  traverser  (traversable,  impassable).  La  capacite  a  utiliser  des  valeurs 
continues  de  capacite  a  traverser  entre  0  et  1  est  deja  en  place.  Ceci  pourrait  avoir  le  potentiel 
d’ameliorer  l’efficacite  de  la  carte  de  parcours  traversable  concernant  l’evitement  d’obstacles  en 
evitant  les  zones  d’herbe  longue  et  epaisse  ou  les  zones  proches  d’obstacles.  D’autres  dangers 
tels  que  la  rugosite  ou  les  bordures  devraient  etre  evalues  pour  determiner  l’efficacite  du  systeme. 
De  surcroit,  la  carte  de  parcours  traversable  globale  doit  etre  evaluee  avec  1’ implementation 
D*  Lite  de  RDDC. 

Bien  que  la  carte  de  parcours  traversable  ait  atteint  un  certain  succes  a  ce  point-ci,  la  methode  ne 
fonctionne  pas  aussi  bien  dans  les  zones  tres  herbeuses  telles  que  celles  rencontrees  lors  de  la 
navigation  hors  route.  Dans  ces  cas-la,  la  carte  est  incapable  de  differencier  entre  les  obstacles 
«  reels  »  tels  que  les  roches  et  les  «  faux  »  obstacles  tels  que  l’herbe.  Pour  reussir  dans  un  tel 
environnement,  cette  methode  devrait  etre  supplementee  par  un  algorithme  d’apprentissage  qui 
permettrait  a  la  carte  de  distinguer  entre  les  differents  types  de  terrains.  La  Section  des  systemes 
autonomes  conduit  la  recherche  dans  le  domaine  de  Traficabilite  acquise  depuis  un  certain 
nombre  d’annees  et  est  bien  positionnee  en  tant  que  telle  pour  apporter  une  contribution  meritoire 
dans  ce  domaine. 


VI 
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1  Introduction 


Scientists  at  Defence  R&D  Canada  -  Suffield  have  been  investigating  autonomous  operation 
of  Unmanned  Ground  Vehicles  (UGVs).  In  order  to  navigate  unknown  terrain  effectively, 
UGVs  must  be  able  to  create  an  accurate  representation  of  their  operational  environment. 
This  is  typically  done  by  constructing  a  spatial  representation  of  the  environment  from 
exteroceptive  sensors  such  as  laser  or  stereovision  sensors  and  proprioceptive  sensors  such 
as  GPS  and  IMU  sensors.  These  representations  are  utilized  by  path  planning  and  obstacle 
avoidance  algorithms  to  determine  the  “best”  path  to  follow. 

A  popular  world  representation,  particularly  for  outdoor  mapping,  is  the  Terrain  Map, 
sometimes  referred  to  as  the  Digital  Elevation  Map  or  the  2.5D  map.  The  Terrain  Map 
tessellates  the  environment  into  2D  grid-cells.  Geometric  data  provided  from  range  sensors 
is  then  accumulated  into  each  cell  in  an  effort  to  estimate  the  height  of  the  terrain  at  the 
cell  location.  Stereovision  cameras  and/or  nodding  laser  scanners  are  typical  employed  to 
provide  the  range  data,  although  radar,  sonar,  etc.  may  also  be  employed. 

Many  Terrain  Maps  are  further  abstracted  to  provide  a  measure  of  traversability  of  the 
terrain  by  the  UGV.  Typically  this  is  done  by  calculating  various  map  statistics  such  as 
roughness,  pitch,  step  height,  etc.  These  statistics  can  then  be  compared  to  vehicle  spe¬ 
cific  thresholds  to  determine  if  the  grid-cell  is  traversable,  impassable,  or  unknown.  This 
abstraction  allows  easy  integration  into  path  planning  and  obstacle  avoidance  algorithms 
by  reducing  the  data  dimensions.  Another  advantage,  is  the  portability  of  the  algorithm  to 
different  platforms  which  only  requires  that  the  user  change  the  vehicle  specific  parameters. 

This  paper  discusses  the  generation  of  Traversability  Maps  from  Terrain  Maps.  Section  2 
provides  background  information  into  Terrain  and  Traversability  Mapping,  while  Section  3 
describes  the  algorithm  employed  in  the  Cohort  project.  Section  4  discusses  software  design 
and  implementation  issues.  Section  5  provides  results  from  trials  held  in  the  fall  of  2006. 
Finally,  Section  6  presents  our  conclusions  and  future  work. 

2  Background 

2.1  Terrain  Mapping 

Robots  employ  many  navigation  strategies,  based  upon  a  variety  of  assumptions  with  re¬ 
spect  to  their  operational  environment  [1].  Early  research  followed  the  sense,  model,  plan 
and  act  paradigm  (SMPA)  [2,3],  where  the  robots  environment  was  structured,  predictable 
and  assumed  to  be  known.  Real  environments  are  unstructured  and  unpredictable  and 
thus  the  performance  of  a  deliberative  SMPA  approach  can  be  poor.  The  reactive  school 
of  thought,  pioneered  by  Brooks  [3,4],  used  the  environment  itself  as  the  world  model  for 
the  robot.  This  approach  resulted  in  robust  behavior  for  unstructured  environments,  but  it 
did  not  yield  useful  application  due  to  the  inability  to  direct  the  robot’s  behavior.  Current 
robotic  research  exploits  both  the  SMPA  and  deliberative  approaches  by  implementing  a 
hybrid  strategy.  Like  the  SMPA  paradigm,  the  hybrid  approach  requires  that  the  robot 
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create  a  representation  of  its  environment.  A  common  implementation  for  world  repre¬ 
sentation  is  to  view  the  world  as  a  grid  array  of  adjacent  regions.  The  most  simplistic  of 
these  is  the  Occupancy  Grid  [5-7]  where  each  grid  element  is  classified  as  either  occupied, 
not  occupied,  or  unknown  based  on  2D  range  data.  This  type  of  grid  is  useful  for  indoor 
environments  where  obstacles  such  as  walls,  bookcases  or  chairs  are  easily  represented  as 
either  empty  or  occupied  space. 

For  unstructured,  outdoor  environments  the  common  world  representation  is  the  Terrain 
Map  [8-12].  For  Terrain  Maps  each  grid  element  represents  the  elevation  of  the  terrain  at 
the  grid  element’s  location.  The  Terrain  Map,  shown  in  Figure  1,  illustrates  this  grid  based 
representation.  A  grid  element  is  sized  w  x  d  with  each  element  containing  data  such  its 
average  height  and  the  variance.  While  the  Occupancy  Grid  is  actually  a  type  of  Terrain 
Map,  the  term  is  used  here  to  refer  to  maps  which  make  use  of  3D  range  data. 

It  is  not  necessary  that  a  map  represent  just  elevation  data.  Indeed,  many  robotic  maps  are 
capable  of  representing  obstacles  and  other  features,  such  as  hills,  slopes,  bumps  and  dips, 
found  in  outdoor  environments.  This  is  often  done  in  an  effort  to  reduce  data  dimension¬ 
ality  and  provide  more  useful  data  to  path  planners.  For  the  purposes  of  this  paper,  these 
reduced  dimensioned  mapping  algorithms  are  referred  to  as  Traversability  Maps.  While 
many  algorithms  encode  traversability  data  within  the  Terrain  Map,  a  clear  distinction  be¬ 
tween  the  two  is  made  for  analysis  purposes.  In  general,  Terrain  Maps  encode  the  geometry 
of  the  environment,  while  Traversability  Maps  interpret  that  data  into  a  useful  metric  for 
robot  navigation  and  path  planning. 


w 

Vehicle  Origin(l) 

Figure  1:  Typical  setup  of  a  Terrain  Map  where  each  w  x  d  grid  represents  the  elevation  of 
the  terrain  for  that  grid. 
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2.2  Traversability  Mapping 


Traversability  Mapping  translates  high  dimensional  geometric  data  into  lower  dimensional 
parameters  which  are  applicable  to  navigation  and  path  planning  algorithms.  Most  imple¬ 
mentations  calculate  cell  statistics  related  to  the  cost  of  traversing  the  cell.  In  the  simplest 
implementations,  each  cell  can  be  classified  as  traversable,  impassable,  or  unknown.  In 
this  way,  the  Traversability  Map  can  be  thought  of  as  a  2.5D  Occupancy  Grid. 

Systems  such  as  MORPHIN  [13]  used  a  planar  fit  of  terrain  data  to  determine  the  pitch 
and  roll  of  the  terrain  and  residual  data  to  determine  the  roughness  of  the  terrain. 

The  Grid-based  Estimation  of  Surface  Traversability  Applied  to  Local  Terrain  (GESTALT) 
[14]  developed  at  JPL  for  the  Mars  rover  missions  tessellated  the  environment  into  a  number 
of  rover  sized  grids.  Sensory  data  was  collected  into  the  grid  cells  and  potential  traversabil¬ 
ity  hazards  were  calculated.  Straight  and  curved  paths  from  the  rovers  current  position 
were  then  evaluated  to  determine  the  safest  path  that  moved  the  rover  towards  its  goal.  An 
unique  aspect  of  this  algorithm  is  the  ability  to  determine  obstacles  in  a  direction  specific 
manner.  In  other  words  a  slope  may  be  a  hazard  when  approached  from  one  direction,  but 
may  be  perfectly  safe  when  approached  from  another  angle.  Figure  2  shows  the  navigation 
display  used  by  GESTALT.  Despite  the  effectiveness  of  the  approach,  the  GESTALT  sys¬ 
tem  was  implemented  in  a  plan/move/stop/plan  fashion  which  is  well  suited  to  high  risk 
navigation  of  Martian  terrain,  but  less  well  suited  for  continuous  motion  applications. 


r  R  l  r1  PC /Til  Z  ..666.0,2(1 13 -VGZ  Jesrus  GOBI 
ir2j:C.2  rt.olul  l  a  r  STEP  BOUftH  BO  REEF? 


[  Lsf  IfrankCAiiari 

•  and  Djvri 

Figure  2:  The  Athena  Rover  Navigation  Display  depicting  the  Traversability  Map  generated 
using  the  GESTALT  algorithm.  The  dark  blue  areas  are  impassable,  the  red  areas  are 
unknown,  and  the  grey  areas  are  traversable. 


In  [9]  researchers  collected  first  and  second  order  moment  statistics  about  range  points  in 
each  cell.  The  statistics  were  merged  for  a  rover  sized  patch  of  cells  and  the  best  fit  plane 
was  determined.  The  plane  was  used  to  determine  the  following  hazards: 
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•  Step  Hazard  -  The  maximum  height  difference  between  any  pair  of  cells  in  a  patch. 

•  Roughness  Hazard  -  Computed  from  the  residual  of  the  planar  fit  and  compared 
to  a  threshold  roughness  factor. 

•  Pitch  Hazard  -  If  the  slope  of  the  planar  fit  is  above  a  certain  threshold  then  a  slope 
hazard  is  present. 

•  Border  Hazard  -  If  the  cell  borders  on  an  unknown  cell  then  it  has  a  border  hazard. 

Finally  Hazard  Arc  votes  were  calculated  from  the  hazard  data  and  merged  pairwise  with 
waypoint  arc  votes  to  determine  the  best  arc  for  the  rover  to  travel. 

In  [15],  Ye  and  Borenstein  again  used  a  planar  fit  to  estimate  roughness  and  slope  hazards. 
They  then  calculated  Polar  Obstacle  Densities  which  created  a  field  of  repulsion  from 
obstacles.  These  obstacle  vectors  were  summed  for  various  angles  relative  to  the  robot 
thus  creating  a  polar  histogram  from  which  the  best  steering  angle  could  be  selected.  This 
is  an  extension  of  the  well  known  Vector  Field  Histogram  described  in  [16]. 

More  recently,  in  [17]  the  Stanford  Racing  Team  utilized  a  Traversability  Map  based  on  data 
from  six  laser  scanners  registered  with  pose  from  an  Unscented  Kalman  Filter  to  classify 
grids  as  undrivable,  driveable,  or  unknown.  Unfortunately,  pose  error  often  led  to  a  large 
error  in  the  3D  data.  To  correct  for  this  a  Markov  model  was  used  to  probabilistically  test 
for  the  presence  of  an  obstacle  leading  to  an  improved  Traversability  Map.  In  addition, 
parameters  of  the  Markov  model  where  tuned  using  a  discriminative  learning  algorithm 
and  data  labeled  through  human  driving,  as  seen  in  Figure  3.  Data  representing  where  the 
vehicle  traveled  was  labelled  as  driveable  while  an  area  to  the  left  and  right  of  the  vehicle 
was  labelled  as  non-drivable.  This  significantly  reduced  the  instances  of  false  positives  in 
the  map.  Finally,  a  mixture  of  Gaussians  from  RGB  vision  data  was  maintained  for  the 
driveable  area  of  the  Traversability  Map.  These  Gaussians  were  used  by  an  online  learning 
algorithm  to  label  data  beyond  the  range  of  the  laser  map.  Stanford’s  extension  of  the 
Traversability  map  represents  perhaps  the  most  sophisticated  work  in  the  area  to  date. 
However,  it  should  be  noted  that  the  problem  was  formulated  as  a  road  following  problem 
and  has  not  been  tested  in  off- road  navigation  scenarios. 

3  DRDC  Traversability  Mapping 

3.1  Algorithm  Details 

DRDC’s  traversability  analysis  maps  a  fine  resolution  Terrain  Map,  T,  to  a  coarser  Traversabil¬ 
ity  Map,  V.  Similar  to  [18]  and  [9],  the  Traversability  Map  is  composed  of  a  grid  where 
each  element,  denoted  by  the  index  contains  measures  of  Traversability  Vy ,  the  ease 

with  which  a  UGV  can  navigate  the  given  cell,  and  Goodness  of-,  the  accuracy  of  the  data 
used  to  produce  traversability.  So  for  an  element  Vy : 

Vy=(Vy,4)  (1) 
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Figure  3:  Terrain  labeling  for  parameter  tuning  for  the  Stanley  robot.  The  areas  are  labeled 
blue  which  the  UGV  drives  over  whereas  areas  a  fixed  distance  to  either  side  of  the  UGV 
are  labeled  obstacles.  This  data  is  used  to  train  a  learning  system  to  accurately  predict 
whether  terrain  is  traversable  or  not. 


This  information  can  then  be  used  by  path  planning  algorithms  to  determine  an  optimal 
route  through  the  map. 


The  Traversability  Map  is  generated  either  each  time  the  Terrain  Map  is  updated  or  on 
a  timed  interval.  Traversability  Maps  are  non-cumulative  in  the  sense  that  a  new  map  is 
produced  at  every  interval,  but  these  maps  are  based  on  cumulative  Terrain  Maps  data. 
Each  traversability  cell  is  constructed  from  a  subset  of  terrain  cells  Sij  whose  Cartesian 
coordinates  lie  within  the  bounding  box  of  cell  Vij'. 


df%j  (x i ,  yi )  G  Sij  . 


xv  —  0.5u>  <  xt  <  xv  +  0.5n; 
yv  -  0.5 d  <  yt  <  yv  +  0.5 d 


(2) 


where  ( xv,yv ),  ( xt,yt )  are  the  centroids  of  Vij  and  %j  respectively,  w  is  the  width  of  Vij 
and  d  is  the  depth  of  Vij . 


The  subset  Sij  calculates  the  traversability  measure,  V,y  ranging  from  0,  or  fully  traversable, 
to  1,  indicating  non-traversable  terrain.  In  the  event  that  Sij  has  less  than  nvaud  mem¬ 
bers  containing  valid  terrain  data,  the  traversability  is  marked  as  unknown,  otherwise  the 
following  calculations  are  used  to  determine  V*,,-: 
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Calculate  Step  Hazard 


The  step  hazard,  H^,  is  defined  as  a  change  in  elevation  which  the  UGV  cannot  safely 
navigate  and  is  calculated  as  follows: 


f  0 

)  Sma  x 
^  hobst 

{  +1 


Smax  <  0.5 h0bst 

0.5 ^  Smax  V  hobst 


—  h0bst 


(3) 


Where  smax  is  the  maximum  elevation  difference  between  any  of  the  members  of  Sij  which 
contain  valid  data,  and  h0bst  is  the  minimum  step  height  the  UGV  can  safely  traverse. 


Calculate  Slope  Hazard 


The  slope  hazard,  D y,  is  determined  by  fitting  a  plane  to  the  valid  elements  of  Sij.  If 
the  plane’s  pitch  ptJ  or  roll  relative  to  vehicle’s  local  frame  is  greater  than  the  pitch  or 
roll  thresholds,  Pmax  and  rmax  respectively,  the  slope  hazard,  Dy,  assumes  a  value  of  1, 


otherwise  D y  =  0,. 


Pij  V  Pmax  Or  fij  V  T max 

otherwise 


(4) 


Calculate  Traversability 

The  traversability  of  a  grid  cell  HtJ  is  determined  as  follows: 

_  f  1  :  H ij  =  1  or  Dy  =  1  ,  . 

\  H ^  :  otherwise 

The  Goodness  of  cell,  Vij.  is  calculated  as  the  sum  of  variances  of  elevation  data  cr?  in  Sij. 

The  Traversability  Map  is  separated  into  two  different  regions,  a  near  zone  Z\  and  a  far 
zone  Z‘i-  Z\  includes  any  traversability  cells  which  lie  within  a  radius  r\  from  the  UGV 
and  Z2  is  the  remainder.  Z\  typically  contains  large  amounts  of  valid  terrain  data  and 
is  of  greater  accuracy  than  Z-i-  To  reduce  false  obstacles  caused  by  inconsistencies  in  the 
Terrain  Map,  the  step  height  threshold  is  modified  as  follows  where  omod  is  the  obstacle 
height  modifier: 


h'Z2obst  Omodhz  1  obst 


(6) 


3.2  Global  and  Ego  Traversability  Maps 

DRDC’s  traversability  algorithm  is  actually  implemented  as  two  separate  maps,  a  Global 
and  an  Ego  map.  The  Global  map  has  a  global  reference  frame  with  the  center  of  the  map 
corresponding  to  the  UGV  GPS  location  and  is  derived  from  the  Global  Terrain  Map  data. 
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As  the  reference  frame  is  not  local  to  the  vehicle,  pitch/roll  hazards  are  not  calculated  as 
they  are  only  relevant  in  relation  to  the  vehicle  pose.  The  Global  map  is  utilized  by  a  global 
path  planner  [19].  Figure  4(left)  depicts  a  typical  Global  map. 


Figure  4:  Comparison  of  a  Global  (left)  and  Ego  (right)  Traversability  Map  taken  at  the 
same  time  in  a  trial.  Blue,  red,  and  white  cells  indicate  impassable,  traversable,  and 
unknown  cells  respectively.  The  area  enclosed  in  the  rectangle  roughly  corresponds  to  the 
Ego  map. 

The  Ego  map  has  its  local  reference  frame  at  the  middle  of  the  front  bumper  of  the  vehicle 
and  is  created  from  DRDC’s  Ego  Terrain  Map.  Here  the  step  and/or  slope  hazards  may 
be  used  in  calculating  the  traversability  of  a  given  cell.  The  Ego  map  typically  has  smaller 
dimensions  than  the  Global  map  as  it  retains  no  data  which  is  behind  the  vehicle.  This 
map  is  used  for  local  obstacle  avoidance.  Figure  4(right)  depicts  a  typical  Ego  Map. 

4  Implementation 

4.1  Miro 

The  Traversability  Map  has  been  implemented  using  the  Miro  framework  adopted  by  the 
AISS  researchers  at  DRDC  -  Sufheld.  Miro  [20-22]  is  a  framework  that  simplifies  the 
process  of  building  a  robot  by  providing  capabilities  that  are  commonly  used  by  robot 
systems.  In  general,  each  algorithm  exists  in  Miro  as  a  standalone  module.  These  modules 
communicate  through  pre-established  interfaces  (IDL)  in  polled  or  event  driven  fashion. 
Each  algorithm  follows  an  established  design  pattern  which  encourages  reuse  by  cleanly 
separating  the  interface  from  the  algorithmic  details.  The  Traversability  map  follows  the 
Subscribe-Publish  Server  design  pattern  seen  in  Figure  5. 

The  Subscribe-Publish  Server  defines  a  Miro  Server  which  receives  events  of  type  A,  pro¬ 
cesses  this  event,  and  produces  events  of  type  B.  In  the  case  of  the  Traversability  Map  the 
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Figure  5:  The  Subscribe-Publish  design  pattern.  The  StructuredPushConsumer  class  re¬ 
ceives  events  of  one  type,  process  the  data  into  another  event  type  and  send  the  event  to 
the  implementation.  The  event  is  then  dispatched  on  the  EventChannel  via  the  Dispatcher 
class. 

Server  responds  to  events  of  type  MapArrayEventIDL  and  EgoMapArrayEventIDL 
and  generates  events  of  type  TravMapArrayEventIDL  and  Et ravMap Array Even- 
tlDL,  which  correspond  to  the  Global  Traversability  Map  and  Ego  Traversability  Map 
respectively.  The  TravMapArrayEventIDL,  shown  below,  contains  a  number  of  impor¬ 
tant  parameters.  The  EtravMapArrayEventIDL  is  similar  in  structure  and  thus  has 
been  omitted  here. 

typedef  double  TravMapArrayIDL  [CONFEDENCE+l]  [TEMDEX_DEPTH]  [ TINDEX_WIDTH ] 

struct  TravMapArrayEventIDL 
{ 

//The  time  the  map  g enerated 
TimelDL  time  ; 

//The  UGV  pose  when  the  map  was  generated 
PoseTransformIDL  pose  ; 

//Value  indicating  the  type  of  map 
long  maptype  ; 

//Value  indicating  the  depth  of  map 
long  index_depth ; 
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//Value  indicating  the  width  of  map 
long  index_width ; 


/ /X  index  in 
long  x.curr  ; 

the 

map 

indicating 

the 

position 

of  UGV  in 

the 

map 

/ /Y  index  in 

the 

map 

indicating 

the 

position 

of  UGV  in 

the 

map 

long  y  curr  ; 

//The  T  r  av  er  s  ability  data 
TravMapArrayIDL  map; 

}; 


4.2  Utilizing  the  Traversability  Map 

Currently  the  Traversability  Map  is  used  by  two  processes.  The  ObsAvoid  module  utilizes 
the  Ego  Map  to  avoid  positive  and  negative  obstacles  and  perform  local  path  planning  as 
shown  in  Figure  7.  This  is  done  by  projecting  a  series  of  candidate  arcs  through  the  map.  A 
cost  for  each  arc  is  determined  by  the  traversability  of  the  grids  which  the  arc  is  projected 
through.  Arcs  which  pass  through  obstacles  are  vetoed.  Finally  an  arbiter  chooses  the  best 
non-vetoed  arc  to  travel.  Results  utilizing  ObsAvoid  are  presented  in  Section  5. 

The  Global  Traversability  Map  is  used  by  the  findPath  module  which  is  a  global  path  plan¬ 
ner  utilizing  the  D*  Lite  algorithm,  an  incremental  heuristic  search  method  implementing 
goal-directed  robot  navigation  in  unknown  terrain.  The  algorithm  seeks  to  minimize  the 
cost  of  traversing  from  a  start  vertex  to  a  goal  vertex.  This  planner  has  not  been  fully 
tested  as  of  yet. 

5  Experimental  Results 


In  the  summer  of  2006,  field  trials  were  conducted,  under  the  Cohort  project,  to  evaluate 
the  effectiveness  of  Traversability  Mapping  for  long  range  point  to  point  navigation  with 
obstacle  avoidance. 

Having  already  successfully  demonstrated  simple  obstacle  avoidance  using  the  system  the 
previous  fall  [23],  all  efforts  were  directed  towards  improving  the  accuracy  and  robustness 
of  the  mapping  software.  All  algorithms  were  tested  on  the  Koyker  Raptor  UGV,  seen  in 
Figure  6.  The  Raptor  is  a  gas  powered  25Hp  all  terrain  vehicle  with  a  hydrostatic  drive- 
train  which  has  been  modified  for  autonomy.  The  platform  was  equipped  with  the  following 
hardware  1 : 

•  One  quad  Pentium  server 

1  Additional  hardware  available  on  the  Raptor  but  not  used  in  the  field  trials  is  not  listed 
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Figure  6:  Raptor  UGV  used  for  Autonomous  trials  in  the  summer  of  2006. 


•  A  Microstrain  Inertial  Measurement  Unit 

•  A  Sokkia  GSR2600  GPS 

•  A  Pacific  Crest  PDF  RVR  radio  to  provide  DGPS  corrections 

•  2  SICK  laser  rangefinders  with  a  custom  nodding  mechanism 

•  An  MPC555  micro-controller  for  vehicle  control 

The  UGV  was  given  a  series  of  GPS  waypoints  shown  in  Figure  10.  As  previously  men¬ 
tioned,  a  Traversability  Map  was  generated  using  the  process  described  in  Section  3.  This 
Traversability  Map  was  used  as  input  to  the  ObsAvoid  candidate  arc  obstacle  avoidance 
algorithm.  The  PurePursuit  and  ObsAvoid  algorithms  each  voted  on  the  set  of  candi¬ 
date  arcs.  As  can  be  seen  in  Figure  7,  the  ObsAvoid  algorithm  would  veto  an  arc  if  an 
impassable  cell  lies  within  that  arc,  otherwise  a  costing  function  was  used  to  calculate  the 
cost  of  traversing  the  arc.  The  PurePursuit  algorithm  would  vote  for  each  arc  based  on  its 
ability  to  steer  the  UGV  towards  the  straight  line  path  between  waypoints.  Finally  an  arc 
arbitration  algorithm,  ArcArbiter,  selected  the  best  arc  from  the  competing  votes.  Figure 
8  depicts  the  entire  system.  Details  of  the  Pure  Pursuit  algorithm  can  be  found  in  [24] .  The 
ArcArbiter  is  similar  to  the  DAMN  architecture  described  in  [25] .  The  ObsAvoid  algorithm 
is  similar  to  the  MORPHIN  and  GESTALT  systems  described  in  [13]  and  [14]. 

The  Traversability  Map  was  configured  with  50cm  x  50cm  cells,  while  the  size  of  the  map 
was  16m  x  16m.  Though  the  size  of  the  map  was  16m  x  16m,  data  was  inaccurate  beyond 
12m.  and  thus  the  nodding  SICK  lasers  were  adjusted  such  they  they  did  not  nod  beyond 
this  distance.  The  maximum  speed  the  UGV  traveled  was  roughly  1  m/s.  This  was  limited 
partially  by  the  nodding  rate  of  the  lasers.  Due  to  an  issue  with  our  stepper  motors  we 
were  unable  to  nod  our  mechanism  any  faster  than  roughly  25  degrees/sec,  as  this  would 
cause  the  stepper  motor  to  jitter  and  produce  noisy  data. 
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Figure  7:  Traversability  Map  with  Obstacle  Avoidance  arcs  overlayed.  Vetoed  arcs  appear 
black  while  safe  arcs  appear  blue. 


Step  and  slope  hazard  parameters  where  chosen  as  25cm  and  15  degrees  respectively.  The 
low  slope  and  step  thresholds  were  chosen  such  that  even  slight  positive/negative  obstacles 
such  as  road  grades  and  ditches  would  appear  as  hazards.  Terrain  representative  of  the 
course  can  be  seen  in  Figure  9. 

The  UGV  was  given  a  series  of  5  waypoints  to  follow,  as  seen  in  Figure  10.  These  waypoints 
were  located  at  various  positions  on  a  grid  road  bounded  by  a  graded  ditch  and  grassy  areas. 
The  UGV  was  able  to  navigate  through  all  5  waypoints  with  minimal  intervention  2.  As 
can  be  seen  in  Figure  10,  the  actual  trajectory  taken  by  the  UGV  consistently  followed 
the  road.  This  proves  that  the  slope  and  step  hazard  metrics  are  sufficient  for  detecting 
negative  obstacles.  In  addition,  two  buildings  (positive  obstacles)  were  successfully  avoided. 

As  the  UGV  was  not  explicitly  road  following  it  would  sometimes  exhibit  undesirable  be¬ 
haviour  which  nonetheless  was  consistent  with  the  algorithms  employed.  For  instance, 
where  the  grade  of  the  ditch  was  relatively  flat  (below  the  slope  threshold)  the  UGV  would 
travel  through  the  ditch  following  a  trajectory  to  the  nearest  waypoint.  As  the  grade  of 
the  ditch  steepened,  the  UGV  would  navigate  back  to  the  road  as  the  ditch  was  once  again 
classified  as  impassable.  At  one  point  during  the  run  the  UGV  turned  onto  an  approach 
and  subsequently  got  stuck  instead  of  continuing  to  follow  the  road.  This  suggests  that 
a  road  recognition  algorithm  could  be  used  in  conjunction  with  the  Traversability  Map  in 
order  to  explicitly  label  areas  of  the  Traversability  Map  as  road/non  road. 

2The  UGV  turned  off  the  road  twice  in  an  effort  to  take  a  more  direct  approach  to  a  waypoint.  In 
addition,  the  UGV  was  halted  once  as  vegetation  was  incorrectly  classified  as  impassable 
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Figure  8:  Flow  chart  depicting  the  various  modules  involved  in  the  2006  Raptor  trials.  A 
pose  solution  from  an  IMU  and  GPS  was  used  to  convert  laser  data  into  a  Terrain  Map. 
This  map  was  analyzed  to  produce  a  Traversability  Map.  An  obstacle  avoidance  algorithm 
vetoed  arcs  based  on  traversability  data,  while  the  Pure  Pursuit  algorithm  voted  on  the  arc 
which  would  progress  the  UGV  to  its  goal.  Finally  an  arbiter  chose  the  best  arc  among 
competing  votes.  These  appropriate  steering  and  velocity  commands  were  then  send  to  the 
vehicle. 

Due  to  Terrain  Maps  statistical  nature,  the  derived  Traversability  Map  sometimes  detected 
false  obstacles.  This  could  cause  the  UGV  to  turn  erratically  or  stop  (if  the  obstacle 
appeared  near  the  vehicle).  Once  the  Terrain  Map  accumulated  more  sensor  data,  yielding 
a  more  accurate  statistical  representation,  these  obstacles  usually  disappeared.  However,  in 
early  testing  it  was  discovered  that  the  vehicle  could  get  caught  if  a  false  obstacle  appeared 
close  to  the  UGV  outside  the  range  of  the  laser  scanners.  In  these  instances  no  new  range 
data  was  collected  for  the  corresponding  cell.  In  order  to  alleviate  this  problem,  functionality 
was  added  which  cleared  the  Terrain  Map  data,  and  accumulated  new  data  for  a  number 
of  seconds  before  resuming  normal  operation. 

6  Conclusion 


Traversability  Mapping  attempts  to  parametrize  the  geometry  of  the  environment  into 
useful  metrics  which  a  UGV  may  use  for  navigation  or  obstacle  avoidance.  DRDC  has 
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Figure  9:  Terrain  representative  of  that  found  on  the  trial  site.  (Far-Left)  start  area  - 
The  UGV  would  have  to  navigate  around  the  building  in  the  left  side  of  the  image.  (Left- 
Center)  steep  ditches  characteristic  of  the  trial  site.  These  were  seen  as  obstacles  by  the 
UGV.  (Right- Center)  -  harsh  terrain  which  the  UGV  had  to  negotiate  (Far-Right)  -  straight 
away  bounded  by  sloped  ditches  on  either  side 


developed  such  a  mapping  system  using  generic  range  sensor  data  to  generate  a  2.5D  Ter¬ 
rain  Map.  This  Terrain  Map  is  then  analyzed  to  quantify  traversable  areas,  thus  yielding  a 
Traversability  Map.  This  map  can  then  be  used  by  obstacle  avoidance  and  path  planning  al¬ 
gorithms.  The  Miro  framework  has  proved  effective  in  efficiently  and  reliably  implementing 
the  Traversablility  algorithm. 

In  the  summer  of  2006  field  trials  were  conducted  to  assess  the  effectiveness  of  Traversability 
Mapping  for  obstacle  avoidance.  Results  have  shown  that  this  method  is  successful  for 
recognizing  positive  obstacles  such  as  buildings,  trees,  etc.,  and  negative  obstacles  such 
as  ditches.  This  allowed  the  test  UGV  to  successfully  navigate  through  a  series  of  five 
waypoints  on  a  1.3km  course.  During  testing,  the  UGV  routinely  chose  to  travel  on  the 
road  without  any  knowledge  of  what  a  road  is  thus  proving  the  statistics  calculated  are 
sufficient  for  recognizing  safe  corridors  of  travel. 

7  Future  Work 


Future  work  in  Traversability  Mapping  will  focus  on  improving  system  robustness  and  in¬ 
creasing  the  accuracy  of  the  maps.  Currently,  the  UGV  is  limited  to  running  at  very  slow 
speeds  due  in  part  to  a  mechanical  error  in  the  laser  nodding  mechanism  which  causes  large 
errors  in  laser  readings.  Improvements  to  this  mechanism  should  improve  map  generation 
speeds.  In  addition,  sun-visors  are  being  fabricated  to  reduce  the  instances  of  laser  dazzle; 
an  error  which  occurs  when  excessive  sunlight  causes  the  laser  to  fail.  In  addition,  work  will 
continue  with  Traversability  Mapping  to  determine  the  robustness  of  the  algorithm.  Cur¬ 
rently,  the  obstacle  avoidance  algorithm  only  works  with  discrete  traversability  (traversable, 
impassable).  The  capability  is  already  in  place  to  use  a  degree  of  traversability  value  be¬ 
tween  0-1.  This  could  potentially  improve  the  effectiveness  of  the  Traversability  Map  for 
obstacle  avoidance  as  rough  areas  or  areas  near  obstacles  may  be  avoided.  Other  hazards 
such  as  roughness  and  border  hazards  should  be  evaluated  to  determine  their  effectiveness. 
Furthermore,  as  previously  mentioned,  the  Global  Traversability  Map  has  yet  to  be  tested 
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Figure  10:  Site  of  the  Raptor  autonomous  road  following  field  trials.  The  red  points  indicate 
the  GPS  waypoints  which  the  vehicle  must  navigate.  The  orange  track  indicates  the  straight 
line  trajectory  which  the  UGV  attempts  to  follow,  while  the  blue  track  indicates  the  actual 
trajectory  which  the  UGV  followed  as  a  result  of  obstacle  avoidance. 


with  DRDC’s  D*  Lite  implementation. 

Despite  the  successes  that  Traversability  Mapping  has  achieved  thus  far,  the  approach  does 
not  work  nearly  as  well  in  heavily  vegetated  areas  such  as  those  encountered  in  off-road 
navigation.  In  these  cases  the  map  is  unable  to  differentiate  between  “real”  obstacles  such 
as  rocks  and  “false”  obstacles  such  as  grass.  In  order  to  be  successful  in  this  environment 
this  approach  must  be  supplemented  with  a  learning  algorithm  which  would  allow  the  map 
to  distinguish  between  various  types  of  terrain  as  in  [26]  and  [27] .  AISS  has  been  conducting 
research  in  Learned  Trajficability  for  a  number  of  years  [28]  and  as  such  is  well  positioned 
to  make  be  a  worthy  contribution  in  this  area. 
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